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@ System.ncludlnganautopl.ct.wlthaslm«lator.f<»all«.dh6rne«^^^^ 

® A sy^em (Fig. 1). having an autopilot, with ^ ^^J^j^^'i^^^^^ '^ulf J'^L^^Srw'S? -^^^^^ 
Vcludiriaphysical part (10). having means representr^m^^ dlsturt»ance forces, and 

to tie Sb^nlng of an ordered depth, the dynamics ateo b^ng ^^^^^^^ ^ ^e^on variables. The 
Selur^ment means (12) provi^ng ^^"^^TT^^^^ values of the state v^-; 
simulator, or state estimator (14). provides signals ffP"™^" . oroviding signals each representative of 

outVtrim'pilching moment, acting on the submanne. 
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Hereinafter in this specificaflon and tha a/w«.— • . 
state being the ordered depth of th'e subm^-JTSrif '^^^"^ ""^ « ottered 

« state variables employed 1^ <U^,^ TZeZ^'^.^'^J' ^ " 
vanabtes indicate related variables capable oS^L i^^J'^^^ "'^'^ °^atlon 
andr'or to the rt,alntenance. of the ordied depth vvfth respect to the obtaining. 

« Of state variables, and the y^^Z'^^^J^T^Z ^'^«°"*'P between the vS 
th^state variables vector transformed In SoSSS i^'^lH!.'*^ observations vector comprises 
vector refers to a column only matrix. * Pwdetermlned measurement matrix. The tem, 

Inherently, the submarine is also subiecfad In «v»» 

^ subm^ne. and represented by a dfsturiMnMvertT^ <««turijance forces, affecting the dynamics of the 

receiye!p<STbVSite*r ^tC^^TZiT^S'^^ *l ^ « ««nged to 

depth In response, the controlle? is m^^to ^'^L'^'^'^'^ 
*«*j™n'n9 the desired values of controls. S^c«i£^JJ^^!^^'^ S'Snal 
ttirusters. Thus, there is caused squired. co^S^Sno ^, hydroplane deflections, or 

» dynamics of the submarine, so that ie o^I^^^S^^ZT 'L^^', ^^^'^^ -^Presenting the 
represents a sonalled control Input vectoT " "^^i"*^- Each control ^gnal 

Hence, at autopilot can be considered to bn a na.* * 
ordered depth signals, and. In response the aufoofi? i?^ ^ °f>^'^ automatically upon 

to be Obtained, and/or there L7to to SiniJl''^^^ whereby there 

'<« known for the autopilot to Iriclude a MX?/^r^' !'^®™''''^P"'^ 
Of any instantaneous error betJ^Jt^t'^^^:^'^ "^'^ ^9"^' «^ «presentatlve 
signals each representative of the derivative ofTe ioS^L^^ '"P"' 
1 •J!..***'^* .P«=h angle. The controller is ,^feS Sll* ? o?*^* "'^^ *he derivative . 

controller operates satisfactorily only when the dSSJ^ . a Proportional Derivative Controller. Such a 
mean with respect to time. Such a SonJrt J^fS^l*^* ^""""^"^ subjected has a zerj 
the «.bmarine is out^-trim. the« then bSnJ TSnZTT^^^ T^"^ *° "^^^ "^"^ «hen 

If the controller also operates upon atom, in^h -T? °' *^®^'"9' o«set from the ordered depth, 
keeping when the sut^^oZ^^^'^^^'^^T V''!' ^ ^^^^^^ depth 

to « a Proportional Integral Derivative Sr^X^tJ' ^!hTJ.'?? '^^'"^ 
relation to depth keeping, and pitch keepi™ whan ih^^fK "'ere are difficulties in 

Changing depth. . ^ '"bmarine is manoeuvring, for example, when 

If the motion of the submarine Is expressed in u,^ ,^ 
controller refenBd to In the preceding to "T^"^ ^ '"P"* "^e 

neous values of variables comprisi^ th^oX-^.^ h *° ^ representative of the Instanta- 

change of pitch, and the depth rmr. ^^r wi^dLd^^^^^^^ P'»=h -«'ocity. the 

8 m r considered to to r presented by a soK:alled vector of state 
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n H has been proposed that the auropnw » »■ » ^ haj^g performed in a part oi 

controller, mstead. « Jj^"^ of depth error, the required 'ntegraMn ojmgp ^ ^ j^e 

koeping when ^^^j'" fte'submarine is n,anoeu^fflng. . ^^^^tor. in 

be considered also « j"i»*"9j;*SSotS estimated values <.f *e ^f^^^^^id^^^ this 
signals, each «P^f!"^;^,f„JSed^^3bsen!atio«s. being ""^''^^^^^.^jS^sT^ remind 

^ variables. « **j;f ^ 2"=' "nside^ 

measurement means. Eacn ou^u « _ considered to be ^o""^^ J"?":^ to the state 

C the system •» «'"P«^J^ t Tc^^ mfoutput of which co-P^^^t "S"^ to each 
the physical part of sya^em.^ computed by the state estimator also Is updatea m h 

. estimator. Thus, the ^"^^^^^^^ output signal is referred to as ^^^^ j^^. 

neous differences Between ^, , „ d-sirable and comprises 

variables. o-neraHty of the problem to all fluid bom vehicles rt is ^^^^ 
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^l^^^^lJ^l^lX^^ 'L?^ '"'^ measurement means, the first 
Observation variables related to tte stT^^ttlT^ L"^"^. ^ observed USs 3 
vector of instantaneous state ohsflrv^^-- wis state observations signal to tBorsst^nt ^ e^Jli. 1 

s ^-^P'-ottherelsacoirc^^^Sa*;:!^^^^^ 
« arranaed to compute tte esti^^.e't,^^^ 

•^ntaBv, Of the estimated ^t^t^ T^, "T* P™^^^ a s'^.S 

hstwaneously estimated state variables, the ^" f. " « '"-^'^l vecS 5 

tor. m addition the first comparator is to^^vTST^^ " *° «"PP»led to the first comoL 
« a function of. any JnstamanSSty wJe^^Si^n "f'*'" 'y^^'"- « stenaTreprBsenWirori^S!; 

e^mated. and the onlered. values of the vBrtV^rloT^^ ***** *^ *V Instantaneous em)r between »» 
;2=alpoJ,on.andtorepresema,^LTeJt^^ 

m^onse. the controller is arranged to proTceTSn^i '"«*"*^"»'y estimated state error variaSSin 

« rrndraSi^-r^A^sr^^^^ 

Zr^T' ^ in^lantZt? Smii''ST ^'"'^ o^^rvatlonni^n' 

SSL J^ ~PP"«* to « ft«her compaiTS^diSf ""^T^' ^ ^""^ obseLons 
"istantaneous observations signal from the ^T^J^ *^er comparator is to nc6«.T«Z 

SS" ^ ^ «««^^i.IeS ^;1^''T:*^" °' instantaneous 

l?l„« ®' ««"Pa«tor. to the computation mwns^ s'Qnal. also Is to be supplied 

m response, and individuaUy on seoarJto ^T.^^ computation means is arranoed teV^-T' 

dfeft.rt=ance. is brought to. and/or b malS\ ^"^'^^'^^l^^'^ to either a yarZT^^sZ 
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sooiled Tank Contents Controller, the outputs of the computation means being coupled to the Tank 
Contents Controller of the remainder of the system, the output of the Tank Contents Controller being 
connected to the physical part of the system and arranged to control the amount, and the distribution, of th 
ballast In the vehicle In the appropriate manner, in response to each signal, from the computation means, 

6 representative of any Instantaneously computed out-of-trim heave force, and any out-of-trim pitching 
moment to act on the vehicle. Such a system, in addition to having novel means to compute any out-of-tnm 
heave force, and any out-of*1m pitching moment, also has novel means to control automatically the 
amount, and distribution, of the ballast In the vehicle, so as to tend to keep the vehteie in trim. 

AKemaBvely, compensation fbr any out-of«lm heave force, and any out-of-trim pitching moment, can 

10 be provided by a system, in accordance with the present im/ention, including means to display, for an 
operator, and in response to signals fhjm the computation means, any Instantaneously computed out-of-trim 
heave force, and any out-oftrim pitching moment to act on the vehicle, the operator to control manually the 
amount and the distribution, of the ballast in the vehicle in an appropriate, and possibly conventional. 

Said remainder of the system also may include means to conrect the ordered vertical- position of the 
vehicle, being both connected to the output of the further comparator, to receive therefrom the instantar 
neous observed estimation error signal, and being connected to a first constituent part of the computation 
means, to receive therefrom a signal representative of any Instantaneous error between the estimated, and 
the ordered, values of the vertical position of the vehicle, with ttie vehicle considered as being m the steady 
state, tiie correction means being arranged to produce, in response, a signal representative of any 
instantaneously estimated error of the ordered vertical position of ttie vehicle with ttie vehicle considered as 
being in ttie steady state, ttiis signal to be supplied to summing means, anranged also to receive, from 
outside ttie system, a signal representative of any instantaneously ordered vertical position of ttie vehicle, 
and in response, to produce a signal representative of ttie oniered vertical position of ttie vehicle estimated 
25 in relation to ttie instantaneous signal from ttie conrection means, the signal from ttie summing means being 
representative of a function of any instantaneously ordered vertical position of ttie vehicle, to be supplied, 
togettier witii ttie instantaneous output estimated state signal from ttie simulator, to ttie first comparator. 

Comfeniently. computations to be perfbnned, by constituent portions of said remainder of the system, 
are obtained by programming a computer of ttie system, In ttie appropriate manner, in accordance wrth 

so predetermined algorrthms, 

The present invention will now be described by way of example witii reference to ttie accompanying 

drawings. In which _ ^ ^ . ^^^^ . ^ ^ 

Rgure 1 is a functional block diagram of a system In accordance wrth ttie present invention, for a 

submarine, ttie system Including an autopilot, witti a simulator, or state estimator, togettier witti means to 
ss compute, in real time, ttie out-of-trIm heave force, and ttie out-of-trim pitching moment acting on. or to act 

on, ttie submarine, ttiere also being indicated. In dotted line fomi, how ttie output of ttie computation means, 

and possibly also an Ordered Deptii Corrector. ODC. may be connected wittiin ttie system, and 
Rgure 2 Is a matrix flow diagram of ttie system of Figure 1. 

40 The symbols employed in representing submarine dynamics, and relevant In relation to a system in 

accordance wttti ttie present invention, are as follows: 

In relation to ttie matiiematical model, fbr ttie submarine when in trim> 

U Forward velocity. 

W heave velocity. 
45 Q Pitch velocity. 

Z Heave force. 

M Pitching moment 

H Deptii of ttie centre of gravity below mean surface level. 
In relation to disturbed motion of ttie submarine:- 
50 a Change of pitch. 

w Change of, or out-of-trim. heave velocity, 
q Change of, or out-of-trim. pitch veloaty. 
* AZ Change of. or out-of-trim. heave force. 
AM Change of, or out-of-trlm. pitching moment 
55 h Change of d ptti from a reference depth, or deptti error. = H-Hqro- 

3b. «s Changes of, respectively, bowplane, and stemplane, deflections. ^ 
The dot above a symbol denotes differentiation wltti respect jto time. e.g. H. 
The bar above a symbol denotes a valu In the steady state, .g. IT. 
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The circumflex above a symbol denotes an estimated value, or vector, e.g. x. 

For what is considered to be a physical part of a system in accordance with the present invention. It is 
possible to consider there is means representing the dynamics of the submarine, the representation being 
in relation to a set of state variables, with respect to the obtaining, and/or to the maintenance, of an ordered 
5 depth. The state variables are> 

w the change of. or out-of-trfm, heave velocity, 
q the change of , or out-of-trim. pitch velocity, 
a the change of pitch angle, and 

H the depth of the centre of gravity below mean surface level, 
10 Together, these state variables can be considered as being represented by a vector, of state^pace 
form. X, and referred to as the vector of state variables. This vejctor has elements:* 
Xt = w 

15 -Xi. » H . 

Related to the set of state variables, referred to above, are observation variables, which are capable of 
being observed, and measured* by what can be considered to be measurement means. Together, these 
observation variables can be considered as being represented by a vector, of state-space form, Y. referred 
to as the vector of state observations. This vector has elements:- 

20 Yi a H 

Ya =0 * 
It can be considered that 
Y » CJC 

where CIs a 2.4 transformation matrix, usually, but not necessarily, with values, 

25 

[b, 0, 0, ij 
0, 0, 1/ oj ' 

Thus, the relationship between the vector of state variables, and the vector of state observations, is 
such that the state observations vector comprises the state variables vector transformed in accordance with 
the predetermined, measurement matrix. C. . 

The differences between the values of the state variables representing the dynamics of the submarine. 
3S Instantaneously ordered values of the state variables, together can be considered as being 

represented by a vector x. referred to as the vector of state error variables, 
X — X-XoRo 

where Xqro is the vector of the ordered values of the state variables. 

In the remainder of the system in accoreJance with the present Invention, there Is an autopilot with a 
^ state estimator. The state estimator, to calculate, in real time, the estimated values of the state variables 
representfng^the dynamics of the submarine, has an output which can be considered as being represented 
by a vector )<, the vector of the estimated state variables. 

Estimated values of the observation variables, considered as being provided by measurement means 
associated with the state estimator, can be considered as being represented by a vector 9. the vector of 
^ estimated ol)servation variables. 

The differences between the estimated values of the state variables, and the corresponding ordered 
values of the state variables, together can be considered as being represented by a vector x, referred to as 
the vector of estimated state enror variables, 
x « 5?-XoRo- 

In distinction to the error temns referred to above, the differences between the values of the state 
variables representing the dynamics of the submarine, and the corresponding output of the state estimator, 
together are considered as being represented by a vector Xg. referred to as the estimation error vector, 
Xg = X-X a x-x. 

The differences between th observed values of the observation variables of the physical part of the 
S5 ^stem, and the corresponding estimated values of tti observation variables, considered as being provided 
by measurement means associated with tfie state estimator, can be considered as being represented by a 
vector Ye, referred to as the observed estimation emr vector, 
Yg = Y-Y. 
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The control values, to cause required, corresponding, changes of the state variables representing the 
dynamics of the submarine, include, for example, the hydroplane deflection changes. Together, these can 
be considered to b represented by a control input vector u. Including i ments ui. representing, for 
example, bowplan deflection changes 5b, and U2, representing stemplane deflection changes 5s. 
5 The extemal disturbance fore s, for example, caused by wav s, and having an effect on the dynamics 
of the submarine, together can be considered to be represented by a disturbance vector f. including 
elements fi = AZ, and fa « AM, respectively, the out-of-trim heave force, and the out-of-trim pitohing 
moment acting on, or to act on, ttie submarine. 

Using the notation refenred to above, the equation of motion of a submarine, and written in continuous 
10 state-space fonm. Is, 
« AJC + B.U + 

where A, B and D represent matrices of transformations considered as being performed within the system. 

Additional matrices refenred to below, in relation to the manner of operation of an autopilot of the 
system, comprise a gain matrix K representing a transformation considered as being performed by a 
15 Kalman filter: and a matrix L representing a transformation considered as being performed by the controller 
of the autopilot 
u = Lx. 

It is aiso necessary to consider the derivatives of zome of the temw refenred to above. The symbols 
employed to indicate hydrodynamic and hydrostatic derivatives are:- 
20 , Zw, Zq, 

Z3b. Z5S. M5b. M5s. 

In relation to the mass m of the submarine, when the speed of the submarine changes such that a finite 
25 Increase in vtotk Is required to be done, not only to accelerate the submarine, but also to increase the 
kinetic energy of the water molecules, there Is what can be considered mathematically to be an increase In 
mass. Similarly, when the submarine is pitching, there is what can be considered mathematically to be an 
increase in the relevant moment of Inertia ly of the submarine. The effective mass of the submarine Is. 
ma » nfi*Z^ , 

30 The effective moment of inertia in relation to pitching is. 

b = ly - M. . 

Taking as a reference datum a submarine which is con'ectiy trimmed and neutrally buoyant, with ttie 
hydroplanes at the balance angles, such ttiat steady level motion is maintained at zero pitch angle, the 
equations of disturbed longitudinal motion. Including depth keeping and pitoh keeping, and in relation to tiie 
35 state, and control, variables, are. 

ma.w = Zw.w + Z<,.q + Zab^b + Zss-^ + AZ 
l2.q = Mw.w + Mq.q + Me.5 + Mfib-^b+Mas^s+AM 
5 = q 

fi = w - u.e 

40 Hence the equation of disturbed longltodinal motion in state-space form is. 
x = Ajc + B.u + D.f (1) 
where 
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**w/l2» *q/l2» ^/l2^ * 
0, If 0, 0 
1» 0, -U, 0 
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0/ 0 
0, 0 



20 



0, 0 

Q, 0 
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40 



45 



50 



55 



The matrices A and B depend upon the forward spe^pd U of the submarine, or a function thereof, but 

are otherwise constant The matrix d is a constant For a vehicle controlled by thrusters, instead of by 
hydroplanes* the hydrodynamic derivatives In the B matrix are replaced by the corresponding derivatives for 
thrusters. 

Since the ordered values of the state variables, otiier than of 14. are all zero. and. H-h. and » Ajc, 
the equation In X corresponding to equation (1) is 
X = AJ< + B.U + D-f. (2) 

. I=or the state estimator, the corresponding equation to equation (2) is 
k a Aj( + B.U. + K.(Y-Y). (3) 

l=br the controller, the relevant equation is 
u a Lx. (4) 

Subtracting equation (3) from equation (2), . 
Xg « (A-ICOJCg + D.f. (5) 

Hence, for a constant speed U, the estimation enror vector. Xg, depends solely on the external 
disturbance vector f, irrespective of any manoeuvre of tiie submarine. 

The derivation of equation (5) does not assume tiie existence of a controller. 

i-toweven It is not possible to compute f directiy from equation (5), because not all the elements of Xg 
are known. Thus, it is necessary to start from Yg, and employ 1-, in order to compute f. 

Provided the determinant (A-K.C) is not singular, Xg will attain a steady state value, {A-ICC^^af. 

it follows that the observed estimation error vector, Yg, also achieves a steady state value. 

Now. as stated above, u ^ Lx. from equation (4); 
A.X = Aj< 
and Yg « CXg. 

Hence, in the steady state, and from a consideration of equation (3), 
0 = (A+B.L). 5 + ICYg 
orx a -(A+B.Lr*X.Yg. (6) 

As stated above, a system in accordance witii ttie present invention Includes an autopilot with a state 
estimator. Various different forms of controller for an autopilot are known. A simple forrn of controller, 
referr d to as a Proportional Derivative Controller, Is arranged to receive input signals each representative of 
any instantaneous error h. b tween tii submarine's depth H» and an ordered deptii Hqro: and possibly also 
input signals each representative of tiie derivative of the depth error h, the change of pitch angle d, and the 
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derlvativ of th change of pitch angle S. Such a controller operates satisfactorily only when the disturbance 
to which the submarine is subjected has a zero mean with respect to time. Such a controller does not caus 
th submarine to keep depth accurately when the submarin is out-of-trim. there then being a constant or 
diverging, offset from the ordered depth. . 

s If the controller also operates upon a term In the Integral of the depth error, /h.dt, the problem, in 
relation to depth keeping when the submarine is out-of-trim. Is overcome, the offset being removed. The 
controller is referred to as a Proportional Integral Derivative Controller. With such a controller, however, 
there are difficulties in relation to depth keeping, and pitch keeping, when the submarine Is manoeuvring, for 
example, when changing depth. 

70 Since, fl « w-U.ff 
and S = q, 

conveniently, the operation of a Proportional DerivatWe Controller should be capable of being expressed in 
terms of the state variables, w, q, 9 and h. together considered to be represented by the vector of state 
en-or variables, x. Further, a matrix transformation can be employed to represent the operation of the 

IS controller. In this specification 'referred to as a matrix transfomnation U. and u = Lx. Therefore, the 
controller should be capable of being embodied within a computer programmed, in the appropriate manner, 
in accordance with predetennined algorithms. 

However, the state variable w. the out-of-trim heave vetodty. cannot be measured readily. Further, the 
measurement of q. the out-of-trim pitch velocity, requires a rate gyroscope, or other Instmment implying 

so that such a system including the autopilot Is complex and expensive. 

Thus, It has been proposed that, advantageously, the autopilot Includes a state estimator, to calcuiate. 
in real time, estimated values of appropriate variables, together represented by the vector of estimated state 
variables. 51 Each signal representative of this vector Is operated upon. wWiln the autopilot to provide a 
con-espondlng signal representative of the vector of estimated state enror variables, x, and this signal is 

25 supplied to the controller, instead of the signal ropresentatWe of the vector of state error variables, x. 

In order to overcome the problem. In relation to depth keeping when tiie submarine is out-of-trim, as 
referred to above, integration of the depth error /h.dt, as with the Proportional Integral Derivative Controller, 
has been proposed for an autopilot Including a state estimator. However, because with a system designed 
to operate upon the state-space fomn of equations of submarine- motion, the controller output, u. is required 

30 to be a linear combination of its inputs, together comprising the vector of estimated state error variables x. 
the desired integration cannot be performed by the controller. Instead, it has been proposed that the 
autopilot is arranged to operate upon an ancillary state en'or variable, comprising the integral of depth en-or, 
xs = /h.dt the required Integration being performed In a part of the autopilot outside the controller. Such 
an anwgement is equivalent to the integration, performed by the Proportional Integral Derivative Controller, 

as being introduced into the controller of an autopitot including a state estimator. As with tiie Proportional 
Integral Derivative Controller, the problem, in relation to depth keeping when the submarine Is out-of-trim, is 
overcome. However, thero remain difficulties in relation to depth, and pitch, keeping, when the submarine is 
manoeuvring. 

There is now described a system, in acconjance with the present invention, including an autopilot, with 
40 a state estimator, and in which system are embodied witii state-space equations of motion of a submarine, 

as set out above. 

A functional block diagram of tfie system Is shown in Rgure 1. 

A physical part of tiie system is considered as having means 10 to represent the dynamics , of the 
submarine, In relation to how ti^e submarine reacts with respect to changes of tiie variable states, or state 

45 variables, of interest for when changes of the depth of the submarine are ondered, and when tiie submarine 
is subjected to extemal disturbances. The dynamics means 10 Is considered as receiving input signals, 
each representative of Uie vector of external dlsturtjance forces f. The dynamics means is considered as 
producing signals, each representative of tine instantaneous vector of state variables X, and representative 
of the dynamics of tiie submarine. This signal is considered as being supplied to measurement means, 

so which. In response, is considered as providing an output signal representative of tiie instantaneous vector of 
obsen/ation variables Y. 

The autopilot, included in ttte remainder of ttie system, includes a simulator, or state estimator 14, to 
cateulate the estimated values of tite state variables, X. The state estimator 14 Is Included in a loop with 
what can be considered to be measurement means 16, conresponding to the measurement means 12 of tiie 
55 physical part of til system, and a comparator 18. In operation, tiie state estimator 14 provides an output 
signal representative of tti vector of instantaneously estimated, state variables St This signal is considered 
as being supplied to tiie associated measurement means 16. which, in response, is considered as 
producing a conresponding signal representative of tiie vector of estimated state obsen/ations. Y. The 
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comparator 18 is arranged to compare this signal with the instantaneous signal considered to be from the 
measurement means 12 of the physical part of the system, representative of the vector of state observa* 
tions, Y. and. In response, provides a signal representative of th observed estimation en'or vector Yb. orS^- 
Y). This signal is fed bacl<, via a Kalman filter, (not separately Indicated in Rgure 1), to the state estimator 
, 5 14, to update the estimated state computed by the state estimator. The Kalman filter prevents drift of the 
output of the autopilot and smoothes the effect of noise within the system upon the output of the autopilot. 

Further, the anrangement of the autopilot, including the state estimator 14. is such that estimated values 
of the elements of the vector of estimated state variables, w. q, and ?, computed. In real time, by the state 
estimator 14, are supplied to the controller, Instead of the corresponding absolute values, w. q. and a. from 
10 the physical part of the system. In addition, the state estimator computes the estimated depth of the 
submarine fl. comprising tfie fourth element of the vector of estimated state variables. X. Thus, the vector of 
^m^ed state variables, X. supplied by the state estimator, has elements 



The output of the state estimator 14 is connected, via a second comparator 20. to the input of a 
controller 22. The second comparator 20, in addition to receiving each output signal X from the state 
estimator 14, also receives each signal representative of the instantaneously ordered depth. Horo, of the 
20 submarine in relation to the mean surface level; or a conrected value thereof. Ho. referred to below. With 
either arrangement the corresponding output signal from the second comparator 20 is representative of the 
instantaneous vector of estimated state enror variables Sc. In relation to the ordered depth Hqro. or in relation 
to the corrected value tfiereof Hq. The second comparator 20 detemnines the estimated deptii enror 
K = H-HoflD = fi-Ho. 

25 Thus, tiie vector of estimated state error variables x, supplied by tiie second comparator 20 to tiie 
controjler 22, has elements 
Xi « w 



The controller 22, In response to this signal, produces a signal representative of the Instantaneously 
required control values, or control input vector, u. This signal is supplied to ttie state estimator 14. to cause 
updating of the estimated state computed by ttie state estimaton and also is considered as being supplied 
to the dynamics means 10. of ttie physical part of ttie system, to cause changes of tfie state variables in ttie 
35 required manner. 

To complete the system, and In accordance with tine present invention, there Is provided means 24 to 
compute, in real time, ttie out-of-trim heave force AZ, and ttie out-of-trim pitching moment AM, botti of 
eittier sense, acting on ttie submarine. Thus, ttie computation means 24 comprises an out-of-trim estimator. 

For convenience, hereinafter in ttiis specification, ttie outnsf-trim heave force AZ Is refenred to as ttie 
-*o heave force; and ttie out-of-trim pitching moment AM is referred to as tiie pitching moment 

^ In relation to the required manner of operation of the computation means 24, and in the steady state:* 
q = 0_ . 

h = w-U. 0. 
Hence JTa « 0 
^5 X. a w'a U.?= U.JTa. (7) ^ 
However, Ye = CJCg = C( r- 5 ). 
This can be partitioned to give. 



Xi = w 




X2 a q 
X3 « £ 
30 Xa = h 
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X. 



where x, 
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and Ci and Ca are th first two and the last two columns of C, respectively. 

Thus Yg « Ci. x"t2 Ca. x'a* - C. x (8) 

Now 



10 where Cu and C12 are the first and second columns of C, respectiveiy. 
Using equation (7).jnd adding a null tern), 
Ci.ria » U.Cii.xa + [OI.X4 . 

t^t Ca a [U.Cn:0lj'C2 and substituting in (8). 

fS Yg a Ca. X"34- C. X . 

If C3 is not singular, _ 
Ta* = C3-'.{Ye+C.5 ). 

Since Xg = x-x and using equation (7), , . 
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- Z* 



*3 



In the special case.o£ 



C » pO, 0, 0, ll 
♦ [p, 0, 1. oj , 



these eqnatloas simplify to, 



- X- 



B2 



'El 



(9) 



50 



Even when the measurement matrix. C, is not of this form, the measurements usually can be corrected 
into the fonnn. — 

Ye is known, and so is x from equation (6). Hence. Xg can be detemiined using equations (9). Further, 
using equation (5), D.f can be detenmined. 

Let the matrix product D.f be represented by D|. 

Since D(1^) = D(ai)=0 
D„ « D(1.1).fi 
and On » D(2.2).f2 
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Hence » the heave force tZ » 

- Pfl 

and the pitching motoent AK » f ^ 

« Pf2 



D(2,2> 
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In particular, the computation means 24 Is arranged to operate upon each signal from the output of the 
first comparator 18. and representative of the observed estimatfon enror vector Yg. In response, the 
computation means 24 is arranged to provide, individually on separate outputs, a signal representative of 
the instantaneous heave force AZ. and the instantaneous pitching moment AM. 

The matrix flow diagram for the system Is shown in Rgure Z 

By a comparison of Rgures 1 and 2. the dynamics means 10 of Rgure 1. can be seen from Rgure 2, 
as being considered as inciurfing means 30 to perfbnn a transformation in accordance with matrix A. means 
32 to perform a transfomiation in accordance with matrix B. and means 34 to perform a transformation in 
accordance with matrix D, Each signal representative of an external disturbance vector f, can be considered 
as being supplied to the D matrix transformation means 34. Each dgnal firom the controller 22 of the 
autopilot, and representative of a control Input vector, u, can be considered as being supplied to the B 
matrix transfonnatfon means 32. Instantaneous output signals from the two means, 32 and 34, can be 
considered as being supplied to summing means 36. the corresponding output signal (B.u + D.f), from the 
summing means, being considered as being supplied to a loop. The loop comprises the matrix transforma- 
tion means 30, summing means 38, and a combination of integrators 40, witii an integrator for each state 
variable. An output signal from the loop, comprising the conresponding output signal from the integrator 
combination 40, and representative of the vector of State variables X, is fed back to the A matrix 
transformation means 30. In response, the means 30 supplies a signal AX to the summing means 38. 
anranged also to receive the instantaneous signal (B.u + D.I), from the summing means 36. The 
corresponding output signal, S: = {AJ< + B.u + D.f), from the summing means 38. is supplied to the 
integrator combination 40. The integrator combination 40 derives an updated value of X from ic, k having 
been derived from a previously updated value of X. 

The physical part of the system is considered as being completed by the measurement means 12, of 
Rgure 1. comprising means 42 of Rgure 2. The measurement means 12 is considered as performing a 
transformation in accordance with the predetennlned. measurement matrix C, on each output signal X from 
the Integrator combination 40. and. In response, providing a signal representative of the vector of state 
observations, Y. 

For tiie autopilot. \he model embodied in the state estimator 14. of Rgure 1, is represented by a portion 
of the matrix flow diagram, of Rgure 2, having a similar form to tiiat considered as representing ttie 
dynamics means 10 of the physical part of tfte system. Thus, each signal from ttie first comparator 18. to 
tfie state estimator 14. and representing ttie instantaneous observed estimation error vector, Ye, is supplied 
to a Kalman filter 44, to filter out noise, but considered as comprising means to perfomn a transformation in 
accordance witti a gain matrix IC Each signal from \he controller 22 of ttie autopilot, and representative of 
tiie control input vector, u. is supplied to B matrix transformation means 46 of tiie state estimator 14. Output 
signals of ttie two means, 44 and 46, are supplied to summing means 48. and, in response, a signal (B.u + 
K.Ye). Is supplied to a loop. The loop comprises matrix transfonnation means 50. summing means 52, and a 
combination of integrators 54. An output signal from tiie loop, comprising tiie conesponding output signal 
from tiie integrator combination 54, and representative of tiie vector of estimated state variables 5?, Is fed 
back to ttie A matrix transfonmation means 50, In response, tiie means 50 supplies a signal A.X. to ttie 
summing means 52, arranged also to receive tiie Instantaneous signal {B.u + K.Ye). from ttie summing 
means 48. The conresponding output signal. X = (aJ< + B.u + K.Ye), from ttie summing means 52. is 
supplied to ttie integrator combination 54. 

The integrator combination 54 derives an updated value of X firom X . X having been derived from a 
previously updated value of 5t 

The measurement means 16, of Rgure 1, comprises means 56 of Rgure 2, considered as performing a 
transfomiation in accordance witti ttie predetermined, measurement matrix C. on each output signal X, from 
ttie integrator combination 54. In response, tiie measurement means 12 provides a signal representative of 
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th vector of estimated state observations. ?. . . . ea «♦ 9 

The controller 22. of th autopilot of Rgure 1. can be considered as compnsing means 58 of Rgure 2. 
The means 58 is considered as performing a transformation in accordance with the matrix L on each input 
signal thereto, the input signal being representative of the instantaneous vector of the estimated state error 
variables 5. Th corresponding output signal from the controller 22 represents the control input vector, u. 

" "■The portion of the matrix flow diagram of Figure 2 relating to the computation means 24. conveniently, 
can be considered as having four constituent parts. u. 1 »u 

A first part 60 of the computation means is arranged to multiply each signal representative of the 
observed estimation error vector. Yb. supplied from the first comparator 18. by a term -(A+Bl)"'. Thus, in 
accordance with equation (6). there is provided, in response, a signal reprasentativ* of the vector of steady 

stete. estimated state error variables. X. . -u. : m 

The second part 62 of the computeUon means is an^nged to operate. In accordance with equations {7), 
(8) and (9). upon the signal representetive of the vector S . and upon the signal representative of the vector 
Yg. In response, the second part is arranged to provide a signal representative of the estimation error 
voctof ' ■ ■ 

The third part 64 is arranged to operate. In accordance with equatton (6). upon the signal representatVe 
of the vector Xs. and. in response, is to provide a signal representative of the product of matrix D. and the 
external disturbance vector f. ^. «m — 

The fourth part 66 Is arranged to operate. In accordance with equation (10). upon the signal . 
representative of D.f. In response, the fburth part 66 Is to provide. Individually at separate outpute thereof, a 
signal representative of the instantaneously computed heave force AZ. and a signal representative of the 
instantaneously computed pitching moment AM. acting on the submarine. 

Thus, the defWences of a system having an autopilot with a state estimator, and with the depth error, n. 
being Integrated, to overcome the problem of depth keeping when the submarine is out-of-tnm. the 
deficiences being in relation to depth keeping, and piteh keeping, when the submarine is manoeuvring, can 

t)e overcome. . ^ 

The arrangement may be such that the instantaneously computed values of the heave force AZ. ana 
pitehing moment AM. provided by the computation rneans 24. are displayed for an operator, both display 
30 and operator being indicated schematically as an intertace 25 between part of the system. In response, the 
operator can control, manually, the amount and the distribution, of the baltest In the submarine in an 
appropriate, and possibly conventional, manner, such as by normal manual control inpute or a Tank 
Contente Controller 26 described hereinafter. Hence, the operator can compensate for the heave force AZ. 
and pitching moment AM. acting on. or to act on. the submarine. ^. ^ • -^»»«„»«..ei„ 

35 Having corrected for the instantaneously computed heave force AZ. and for the instantaneously 
computed pitching moment AM. the steady state error is also eliminated. Thus, the operator bnngs. andftir 
maintains, a submarine, subjected to a varying, or constant disturt)ance. to an ordered depth, with tne 
-submarine in trim. It can be arranged that the stability of the submarine is not affected. Further, it is not 
essential that the submarine Is In a steady state, for example, possibly the submarine manoeuvring dunng 
the compensating action. The desired manner of operation of the system Is unaffected by when, in a 
manoeuvre, a change of depth Is ordered. If the autopilot includes means to Bmit the pitch angte of the 
submarine during a depth change, the effect on the desired manner of operation of the system is negligible. 

In particular, in accordance with the present invention, there is required to be provided wittiin the 
system a signal representative of the observed estimation emw vector. Ye. such as Is provided InherenUy 
4S within a system having an autopilot witii a state estimator. 14. ^ » •« 1 * ^ 

The observed estimation error vector. Ye. has. as is required, a steady value. It Is unimportant if. in tact, 
tills vector has a mean value, ttie actual value varying slowly compared witti ttie response of tine system. 
Such a skw variation of ttie vector Is caused by a varying, unknown, and non-zero mean, dlsturiaance actng 
on tiw submarine, such as the so-called upward "suction force". If tiie observed estimation error vector, Ye. 
so has a steady value, there is a constant dlsturt)ance force acting on the submarine. This vector, desirably 
has a continuous form, and is of tills form if tiie state-space equations operated upon wlttiln tiie system are 

of continuous form. 1 

As stated above, ttie motion of the submarine Is expressed by equations of state-space form, ana tne 

equation 

SS X = Aj< + B.u + • 

is in continuous form. 

The conresponding equation in discrate form can be considered. _ 
If ttie implementation of ttie system employs a digital computer, tiie required computations being 
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performed discretely, at regular Intervals, the discrete form of the equation should be consid red. 
x(n + 1) = AdJc(n) + Bd^(n) + 

when x(n) Is the value of the vector x at the n*th sample, and x(n + 1) Is the value of the vector at the next 
sample- The matrices and Bd ar closely related to those. A and B, In the continuous form. For a short 
5 update Interval 5t 
Atf » (1+A.at) 

= Kit 
andDd » D.5t 
10 where I Is the identity matrix. 

In relation to the matrix flow diagram. Figure 2. the means 40 and 54. do not comprise integrators, but, 
instead comprise a suitable form of updating means. 

The manner of operation of the computation means 24 is subject to the time constants, inherently 
associated with the computation means 24. Because of such time constants, filtering of noisy signals. 
IS produced within the system, is obtained. Means to provide smoothing of ndsy measurement signals, for 
example, due to waves, and passed to me computation means 24, may be included in the computation 
means, especially for when the submarine is at periscope deptti under a seaway. Such smootiiing is 
particulariy Important if the ballast is controlled automatically, In ttie manner described below. 

Advantageously, but not essentially, in a system in accordance with tiie present invention, and as 
20 indicated in F«ures 1 and 2. in dotted line fdnn. botii Instantaneous output signals from the computation 
means 24. and representative of tiie heave force AZ, and tiie pitching moment AM, acting on tiie 
submarine, are suppfied to suitable automatic tfiat is, non-manual, fonm of interface means 25. Including 
sign changing means. In response, the interface means 25 produces a signal supplied to tiie aforemen- 
tioned Tank Contents Controller 26, arranged to control tiie amount and tiie distribution, of ttie bailast in the 
2S submarine. In response to each signal from tfie interfece means 25, ttie Tanic Contents Controller 26 
computes the changes In tiie tani<s* contents which will have a resultant change in tiie heave force, -AZ. 
and a resultant change In the pitching moment. -AM. The Tank Contents Controller 26 also is arranged to 
cause, automatically, tiie pumping, flooding, and transfer pf ballast fo produce tfie desired changes of ttie 
heave force. -AZ. and Oie pitching moment -AM. 

If ttie pumping can occur at a high rate. It is required tiiat the Tank Contents Controller 26 includes 
llmiters, or otiier means, to ensure tiie stability of tiie control loop of which It forms a part 

As indicated in Figure 2. it is considered tiiat output signals from ttie Tank Contents Controller 26 are 
supplied to summing means 27. of tiie physical part of ttie system, ttie summing means 27 also being 
considered as receiving each signal representative of ttie Instantaneous external disturtDance vector, f. In 
response, ttie summing means Is considered as supplying a signal representative of ttie instantaneous 
-value of (f-AZ-AM), to tfie D matrix transformation means 34 of ttie dynamics means 10. 

The system also may include an Ordered Deptti Corrector (GDC), for ttie submarine, and indicated at 
28 in Rgure 1. in dotted form. 

In relation to ttie equations (1) to (10), derived above from ttie equations of motion of a submarine, it is 
considered ttiat ttie deptti of ttie submarine below mean surface level. H. is also represented by tiie 
element of ttie vector of tiie state variables X*. and by ttie element of ttie observed estimation error vector. 
Yg,. The vector representing tiie error of tiie deptti of the submarine is. 
P^-X4ord) = X* = {Xi-5^ 4^+ S*. 
From equation (9) Xg4 = JT*- x 
From equation (6) 5? = -(A+B-Lr^K-Yg. 
Hencex* = Yei -{A + B.LrM<.YEi. (11) 

The first tenm of ttie right hand side of equation (1 1) Is represented by an element of each output signal 
Yfi. from ttie first comparator 18. Tjie second temi of tiie right hand side of equation (11) is represented by 
an element of each output signal, x . from tiie first part 60 of ttie computation means, shown in Rgure 2. 

Thus, ttie Ordered Deptti Connector (CDC) 28. has two inputs, one to receive a signal representative of 
ttie instantaneous observed estimation en-or vector, Yg. and supplied by ttie first comparator 18; and tfie 
other to receive ttie conresponding signal from ttie first part 60 of ttie computation means 24. showcLin 
Rgure 2, and representative of tfie instantaneous vector of steady state, estimated state error variables, x . 
Hence, part of ttie Ordered Oeptii Conrector. (GDC) 28. can be considered to be common with ttie first part 
60 of ttie computation means 24. In response, tiie Ordered Deptii Corrector (ODC) 28. pro'vid s a signal 
representative of ttie instantaneously estimated, steady state, en-or of ttie ordered deptti aHoRo. 

The output signal from ttie Ordered Deptti Corrector (OOC) 28, is supplied to summing means 29. 
an^nged also to receive ttie instantaneous signal representative of ttie ordered deptii of ttie submarine 
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HoRD. In response, the summing means 29 provides a signal representative of the ordered depth ^mated 
in relaJJon to the instantaneous output signal from th Ordered D pth Corrector. H,. and constdered to be a 
function of the ordered depth. This signal is supplied to the second comparator 20. together with the 
Instantaneous signal from the state estimator 14. and representative of th vector of the estimated state 
variables. Si The coffesponding output signal from the second comparator 20 Is representative of the 
instantaneous vector of estimated state en-or variables, x. partially estimated in relation to the function of the 
ordered depth. referred to above. The output signal from the second comparator 20 Is supplied to the 
controller 22. 

As indicated in the matrix flow diagram of Rgure 2. both each signal from the first comparator 18. and 
representative of the vector Ye. and each signal from the computation means 24. and representative <rf the 
vector X . are supplied to summing means 70 of the Ordered Depth Con-ector (ODC). The signal x Is 
supplied from the output of the first part 60 of the computation means 24. considered to be common with 
the Ordered Depth Corrector (ODC). Each corresponding output signal from the swiffinlng means 70 
represents the instantaneous "vector of state error variables, in relation to the steady state, x . This signal is 
supplied to interface means 72. included In the Ordered Depth Corrector, and arranged to operate upon the 
signal. In response, the Interface means 72 produces the required signal representative of the instantaneous 
estimated error of the ordered depth. SHoro. w m.^ 

The Ordered Depth Corrector. 28. advantageously, has assodated there»»lth a time constant swfln that 
Its output does not fluctuate undesirably when the submarine is at periscope depth under a seaway. 

The Ordered Depth Corrector Is concerned with only one variable, the depth of the submarine. The 
Ordered Depth Corrector computes, in real time, the steady state error, or offset of depth, and applies an 
opposite, compensating, offset to the ordered value. Thus, for a submarine which Is to change, or is 
Changing, depth, the Ordered Depth Corrector operates upon the disturtsance vector f. during the depth 
change. By the time the submarine has arrived at the ordered depth, the compensating offset has already 
been computed, and operated upon, and the final depth is the ordered depth. Applied limits, for example, to 
hydroplane deflecflons. or pitch angle, have only minimal effects on the computation, and these effects 
disappear as the manoeuvre is completed. The submarine may be subjected to a varying, or constant 
disturbanco* 

However, the Ordered Depth Corrector Is not concerned with- the out-of-trim parameters associated with 
the submarine, and cannot quantify the heave force ^ and the pitching moment AM. 

The Ordered Depth Corrector computes the relevant steady state error, and as with the computation 
means, it is not necessary for the submarine to be In a steady state for the Ordered Depth Conrector to 
operate satisfactorily. 

The Ordered Depth Corrector Is capable of operating satisfactorily, because a change of the ordered 
depth caused thereby, does not cause any consequent change of any other state variable of the submanne. 

Further, any change of ordered depth caused by the Ordered Depth Corrector does not affect the 
stability of the submarine. The desired manner of operation of the Ordered Depth Corrector is unaffected by 
when, in a manoeuvre, a change of depth is commanded. ; 

As for the computation means 24, the Ordered Depth Con-ector 28 requires there to be provided within 
the system a signal representative of the observed estimation en^r vector. Yg. such as is provided 
inherently within a system having an autopilot with a state estimator 14. 

As indicated above, instead of being connected to the illustrated Tanl< Contents Controller 26. the two 
outputs of the computation means 24 may be conected to display means, not shown, to indicate, to an 
operator, the instantaneously computed heave force A2, and the instantaneously computed pitching 
moment AM. Conveniently, the arrangement is such that the system has a so-called quick trim mode. An 
operator, observing the displayed heave force, and pitching moment values, periodically can Initiate this 
mode. In this mode the system performs, automatically, procedures whereby ballast and trim errors are 
reduced to nominal zero. Concunrently, equivalent hydroplane angles reduce until they are the same as the 
so-called set balance angle. The equivalent hydroplane angles maintain the steady state set depth, and are 
referenced to balance angles, the depth being set by the controller of the autopilot, so as to obtain a 
desired state variable value. 

Changes to the dynamics of a submarine caused by ballast changes, inherently, are slower tnan 
changes to the dynamics caused by hydroplane deflection, or thruster. changes. An Ordered Depth 
Corrector 28 is concerned only with required hydroplane deflection, or thruster, changes; and tiie computa- 
! lion means 24 is concerned only with required changes of the ballast of the submarine. ^ 

Inherentiy. the output of the Order d Depth Corrector (ODC) 28, is independently of the output of the 
computation means 24. and so the optimum arrangement is for the system to Include both the computation 
means 24. and th Ordered Depth Conrector 28. operating simultaneously. Thus, the Ordered Deptti 
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Corrector 28. can bring the submarine to an ordered, steady state, depth faster than by an adjustment of 
ballast caused, r indlcat d, by th computati n means, 24. Subsequently th submarine i brought to be in 
trim, in accordance with th output of th computation means 24. The Ordered Depth Con-ector is arranged 
to be part of an autopilot of the system. The computation means is connected to a Tank Contents Controller 
26; or is connected to display means, and the system, desirably, is an^ged to have a quick trim mode, as 
referred to above. 

A system in accordance with the present Invention may be for a missile, airship, airaaft or surface 
ship, instead of for a submarine. 

If the system is for a missile, airship, or aircraft, and the ordered state Is the height of the vehicle, and if 
the system includes an Ordered State Corrector, then the Conrector comprises an Ordered Height 
Conrector, instead of the Ordered Depth Corrector for a submarine. 

Conveniently, computations to be performed, by constituent portions of the system, except the physical 
part of the system, are obtained by programming a computer of the system. In the appropriate manner, In 
accordance with predetermined algorithms. 

Claims 

1. A system including an autopilot, with a simulator (14). for a fluid borne vehicle, the vehicle to be 
subjected to external disturbance forces, affecting the dynamics of the vehicle, has a physical part, the 
dynamics of the physical part (10) is arranged to produce a signal in relation to state variables, the state 
variables signal to represent a so-called vector of instantaneous state variables, with respect to the 
obtaining, and/or to the maintenance, of an ordered vertical position of the vehicle in relation to a reference 
position, the state variables signal is to be supplied to first measurement means (12), the first measurement 
means Is arranged to provide. In response, a signal In relation to observed values of observation variables 
related to the state variables, this state observations signal to represent a so-called vector of instantaneous 
state obsen/ations. the remainder of the system includes the autopilot, in which autopilot there is a 
controller (22) connected, via a first comparator (20). to th0 output of *the simulator, the simulator is arranged 
to compute the estimated state of the vehicle, and, In response, to provide a signal representative of the 
estimated state, the estimated state signal to represent a so^alied vector of instantaneously estimated state 
variables, the estimated state signal is to be supplied to the first comparator, in addition the first comparator 
is to receive, from outside the system, a signal representative of. at least a function of. any instantaneously 
ordered vertical position of the vehicle, in response, the first comparator is to provide to the controller a 
signal both partially representative of any instantaneous error between tfie estimated, and the ordered, 
values of the vertical position In relation to, at least said funtion of. the ordered vertical position, and to 
represent a so-called vector of instantaneously estimated state error variables. In response, the controller is 
arranged to produce a signal representative of a so-called control input vector, this control signal is to 
detemiine the instantaneously desired values of appropriate controls of the vehicle, and both is to be 
supplied to the physical part of the system, to cause changes of the state variables in the required manner, 
and is to be supplied to the simulator, the simulator is arranged to compute, in response, an updated 
estimated state of the vehicle, and also within the remainder of the system, the instantaneous estimated 
state signal to be provided by the simulator, is to be supplied to second measurement means (16). the 
second measurement means is ananged to provide. In response, an estimated observations signal, to 
represent a so-called vector of instantaneously estimated state observations, the estimated obsen^ations 
signal is to be supplied to a further comparator (18), In addition the further comparator is to receive the 
instantaneous observations signal from the first measurement means of the physical part of the system. In 
response, the further comparator is to provide a signal representative of any Instantaneous difference 
bsNveen the observed, and the estimated obsen/ed, values of the obsen/afon variables, the observed 
estimation error signal to represent a so-called vector of observed estimation en-or. ttiis observed estimation 
error signal is to be fed back to the simulator, and the simulator Is arranged to compute. In response, an 
additionally updated estimated state of the vehicle, and the system is characterised in that the remainder of 
the system also includes computation means (24), the observed estimation errorslgnai. also is to be 
supplied, from the further comparator, to the computation means, and the computation means Is arranged to 
provide, in response, and Individually on separate outputs, a signal representative of the Instantaneous out- 
of-trim heave force, and a signal representative of the instantaneous out-of-trim pitching moment, to act on 
the vehicle. 

2. A system as claimed in claim 1 characterised by being adapted for a submarine. 
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3. A system as claimed in claim l. or daim 2. characterised in ttiat the outpute ^^e ^omputeton 
means (2? are coupled to a so-called Tank Contents Controller (26) of said remainder of the system, the 
of Se Tank Contents Controller is connected to the physical part (10) of the system. ^ ^^^ 
to^trol the amount and the distribution, of the ballast In the vehicle in the appropriate ma^. in 
response to each signal, from the computation means, representative of any instantaneously computed out- 
of-frim heave force, and any out-of-trim pitching moment, to act on the vehicle. 

T A?JirS claimeJ in claim 1. or claim 2. characterised by including means (25) to displayjor an 
operator, and in response to signals from the computation means (24). any instantaneously computed out- 
of-trim heave force, and any out-of-trim pitching moment, to act on the vehicle. _ 
5. A system as claimed In any one of the preceding claims characten^d 'ncludingjn sad 
remainder of the system, means (28) to correct the ordered vertical position of m 
means both Is connected to the output of the further comparator (19). ^J^^^^Z Z^'^^^ 
neous observed estimation error signal, and is connected (70) to a first constrtuent ««rt ^ of *e 
STutaBon means, to receive Uierefrem a signal representative of any instantaneous en-or between the 
SZS. and the ordered, values of the vertical position of the vehicle, v^ith the vehicle co^^ered as 
being In the steady state, the correction means Is arranged to produce, in response. « «f ^^Pf^f "^^^ 
of ^y instantaneously estimated error of the onJered vertical position of the *tul^^^^^ 
considered as being In the steady stale, this signal is to be supplied to summing means 29). the summmg 
also I, to rJcelve IWm outside the system, a signal representative of any '"^^^^^^^ ^T^^^^^^^ 
position Of the vehicle, m response, the summing means is to P«>J~ ^.^r^/^P/^^'^^^^^ 
any instantaneously ordered vertical, position of the vehicle esUmaled In relatten to fj'^^^ 
from the correction means, this signal from the summing means is to be «pr^enlatve f^^^^" 
ISnto«ously ordered vertical position of the vehicle, and is to be supplied, together with the instanta- 
neous estimated state signal from the simulator, to the first comparator (20). ,^ 

t Aljstem as claimed in any one of the preceding claims, characterised in J^f « f;l^9^«"* 
such that computations to be perfomied, by constituent portions of said remainder of the system are to be 
TbSned by pESramming a Snputer (24) of the system, in the appropriate marker. In accordance with 
predetermined algorithms. 
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